Optimizing Robot Paths